#include "ImitateI2C.h"

ImitateI2C imitateI2C0;

void ImitateI2C_Init()
{
    ImitateI2C_Pin_Init(&imitateI2C0, PB6, PB7);
}

void ImitateI2C_Pin_Init(ImitateI2C *imitateI2C, u8 pin_scl, u8 pin_sda)
{
    imitateI2C->sda = pin_sda;
    imitateI2C->scl = pin_scl;
    Pin_Mode(imitateI2C->sda, PIN_MODE_OUTPUT);
    Pin_Mode(imitateI2C->scl, PIN_MODE_OUTPUT);
    Pin_Out(imitateI2C->sda, 1);
    Pin_Out(imitateI2C->sda, 1);
}

void ImitateI2C_Start(ImitateI2C *imitateI2C)
{
    imitateI2C->busy = true;
    Pin_Mode(imitateI2C->sda, PIN_MODE_OUTPUT);

    Pin_Out(imitateI2C->sda, 1);
    Delay_Us(5);
    Pin_Out(imitateI2C->scl, 1);
    Delay_Us(5);
    Pin_Out(imitateI2C->sda, 0);
    Delay_Us(5);
    Pin_Out(imitateI2C->scl, 0);
    Delay_Us(5);
}

void ImitateI2C_Write(ImitateI2C *imitateI2C, u8 data)
{
    Pin_Mode(imitateI2C->sda, PIN_MODE_OUTPUT);
    Pin_Out(imitateI2C->scl, 0);
    Delay_Us(5);
    Pin_Out(imitateI2C->sda, 0);
    Delay_Us(5);

    for (int i = 0; i < 8; i++)
    {
        if (data & 0x80)
        {
            Pin_Out(imitateI2C->sda, 1);
        }
        else
        {
            Pin_Out(imitateI2C->sda, 0);
        }

        Pin_Out(imitateI2C->scl, 1);
        Delay_Us(5);
        Pin_Out(imitateI2C->scl, 0);
        Delay_Us(5);
        data <<= 1;
    }
}

u8 ImitateI2C_Read(ImitateI2C *imitateI2C)
{
    u8 data = 0xaa;
    Pin_Mode(imitateI2C->sda, PIN_MODE_INPUT);

    Pin_Out(imitateI2C->scl, 0);
    Delay_Us(5);
    for (int i = 0; i < 8; i++)
    {
        Pin_Out(imitateI2C->scl, 1);
        Delay_Us(5);
        data <<= 1;
        if (Pin_In(imitateI2C->sda))
        {
            data |= 0x01;
        }
        else
        {
            data &= (0xFE);
        }
        Pin_Out(imitateI2C->scl, 0);
        Delay_Us(5);
    }
    return data;
}

void ImitateI2C_End(ImitateI2C *imitateI2C)
{
    imitateI2C->busy = false;
    Pin_Mode(imitateI2C->sda, PIN_MODE_OUTPUT);

    Pin_Out(imitateI2C->sda, 0);
    Delay_Us(5);
    Pin_Out(imitateI2C->scl, 1);
    Delay_Us(5);
    Pin_Out(imitateI2C->sda, 1);
    Delay_Us(5);
}

bool ImitateI2C_ACK(ImitateI2C *imitateI2C)
{
    Pin_Mode(imitateI2C->sda, PIN_MODE_INPUT);
    Pin_Out(imitateI2C->scl, 0);
    Delay_Us(5);
    u16 time = 10000;
    while (time--)
    {
        if (Pin_In(imitateI2C->sda) == 0)
        {
            Pin_Out(imitateI2C->scl, 1);
            Delay_Us(2);
            Pin_Out(imitateI2C->scl, 0);
            Delay_Us(5);
            return true;
        }
        Delay_Us(5);
    }
    return false;
}

void ImitateI2C_NAK(ImitateI2C *imitateI2C)
{
    Pin_Mode(imitateI2C->sda, PIN_MODE_OUTPUT);
    Pin_Out(imitateI2C->scl, 0);
    Delay_Us(5);
    Pin_Out(imitateI2C->sda, 1);

    Pin_Out(imitateI2C->scl, 1);
    Delay_Us(5);
    Pin_Out(imitateI2C->scl, 0);
    Delay_Us(5);
}
